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(54) WALKING POSTURE GENERATION DEVICE FOR LEG TYPE MOVING ROBOT 

(57)Abstract: 

PROBLEM TO BE SOLVED: To smooth the vertical 
movement of an upper body and movement of joints by 
providing an upper body vertical target position deciding 
means which decides the vertical target position of the 
upper body based on the upper body locus and a leg part 
link locus. 

SOLUTION: A walking way of the feet is decided so as 
to be stored in a ROM 84 of a control unit 26 as a foot 
flat locus parameter. An upper body locus parameter is 
so decided as to satisfy a decided target ZMP and 
stored in the ROM 84. The stored parameters are read 
out one after another so as to be inputted in a foot flat 
locus calculation algorithm and an upper body locus 
calculation algorithm so that a leg part link locus 
containing at least either one of the target position or 
the posture in the tip part of the leg link, namely, the 
foot flat position and posture of the both legs and the 
upper body posture and a horizontal position are 
calculated. 
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jSS£-rs±»©i«3 z b«w&r&. 



(6) 



C > CO • • • ft, 7 

f(0sup,0swq ) =C • • • ft8 a 
q(Xb,Zb,Xsup,Zsup,Xb,Zb,Xswq,Zswq) = C • • -S8b 
[0 05 1] 14«2©«W 

m-gomr cc*jt,»r«. ±<*W3 z b zm^c&m-rti 
«. B3Mii5*^s¥ (smras) iwrnmt. w©s 

3 2 LJ:9&*£fie&t§£f#-?r/h3t,>. BP*s. Jbf** 
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* ffi3 Z b 5rJia CCU^Tn^ S2a, ft,2 b. S3f 
^tfXbft&Ssup iSswg ifi%lC-Xft%:ffiSL-? & d1fi& 

[0 05 2 ] 6 sup > 5A»O0 swg > S ■ ■ • ft,9 
gi f *5|5l-©fig^J#-PC<»:. fcJ:t>*5U <b5£9*>>6. 

±f*iti3 z b *si^(c^-rn«. s: i o «£3ft 



g(Xb,Zb,XSup,Zsup,Xb,Zb,Xswq,Zswq)< 1/sin (S) +l/sin(S) 



SCI 0 



[0 05 3] C©££©±f*BS3*>e>J£'7Ct±f£ig;3 4 
S. C«t, «£flt&J5^£ffS©C(C#tl,T. 5£8 b 

£?iSJE-r£jb{*i«3 z bitfttetzc tzmwrz. 

Vsin( 5) + l/sin( S) <C <MPB^: ■ • - Si 1 
Vsin( 6") +l/sin(S) SrCOifcWtf. 14112 #f#<5 

[0 054] $/c, 14fi 1 *»6;K©teRaJ*&»*lS. 
[0 05 5] 14113 

Si8 a $ /ct-^8 b ^«S-T-S±1*iiS5 Z b WC */h3 

i*< (SKft-S). CfcfcRAJC** <■*-*£. ±1*i« 20 
SZb«*2©8e3feft«#ffi©±1*i«3(CJR«^-*. $ 

[0 05 6] 142?4 

SCtcttoroia^K. — #©JW©5fc$*f#%±tf£ 

i. *©i*ttjii&o. Js>ftwi©WA 5 i#5S-rSo an%. m 

&<t>3<&£o 30 

[0057] imzmmt t,r. c©aat©ttf^*Bi9i 
-rs 0 

[0 05 8] 04{C^-rjp< . £©§|g». J£¥$liBfr|fL 

i©$tf©!l#14«^d?)6n, *ft{c8-3i»-rjS©ilCf 

BUtEO/dM®^-* r 2 6©ROM8 4CCf&iffl3ft£„ 
[0 05 9] l^tto^7 7-/>«:te^ril 
ZMPCD<fcB9*i8B£3*i. *©*S3tifcB«ZMP* 40 
«JS-T S J: "5 {C±flt©«U»^t7 X - £ ( * -5 I »ttB$S3»J& 

f(0 sup, 0 swq)= l/sin(0 sup) + l/sin(0 swq) 



:/;!/) *Sftggn, |SJ*i«:ROM8 4F*3CttgJrt£ft 



S„ fSa> ZMP (Zero Moment Point ) *£gtC<fco 

*r**j. «14^£fi;ft©^£/*ffi±©*sfim£$ 

[0 06 0] «MStirt>*^^>-*B«i>dR*aS 

ftra¥*u**tH7 =f y xa*$ j; cfiiwwswaT 
=fi;xA(cA*3n. -ec-CHfriai/fcWgqy >^5^gp 
©B»fi)«*i£0 s 5S»©*l>tt< <fct>i»-**fta»*£tpfMB 
U>5'«fc». HP ft. WW©JSTtiiB • <JH*W«:« 
JE^HHei! 18, 2 0 R ( L) ©&g • s69»> *s£t>*±tt 

[0 0 6 l ] J^AtJrityctt. i57o--?t-hfc 
TVTfcK . S 1 0*6BB*&Lfc». S 1 2 (caL^rlEO* 
WAt (WffiJJSJW. WtflOms) C.-<L©£ 
9ii#4ff«U S 1 4 (C^TBfSiJ 

tSrAtftfWHfcrU S 1 6 (CjtA/CBfglJ t (3^(5EB# 
8S) K*»W*B«Lb»*¥fiai (xb.Yb). SttJbftiBB 
C0xb, Oyb, 0zb) . Pitt©B«S¥ (fi*IW®) ft 
at (Xsup,Ysup,Zsup,Xswg,Yswq,Zsvvg)teJ:C>"^^ (0 xs 
up, 0 ysup , 0 zsup, 0xswg, Syswg, 6 zswq)?:^^ 

-TSo cn6©fsti^B#fit-c*So 

[0 06 2] ^<?S 1 8{C^-catI±ft*3Z b4 

yT^*-CA(<:»Lta-rs. 

[0 06 3] H6«*OBfRi:(*jBfSSKerJU=fyXA 

^-r-y-^ju-^^ • 7Q- • h-c*So 

[0 0641 ^, a 6 VZfn-tT )\>3 <) X MXmifc<D&%. 



SCI 2 



[0 06 5] * fc, ±(fiS3**]£-r«Ai«>C!>«SC4 L/ 
rWT©SC (5fe©2^7cr©^©SC8 aKtBS) 4S 

fC0sup,0swq ) =C • • • JC1 3 
[0 06 6] C©HSS©0fi|-C« t S12. 5£ 1 3 4?S 

s-r -5»±(*iS3 4a«±f*iS3 1 u-c^-r s J; u 
fco ft. ±<*i«34ia«wcci»< ci«J-r*tti>©r- 



50 



**s. 

[006 7]«T. E6©7D-?-t-l-?:Ki^ 

<t. 5trs i o otc*jc>-cani±twssz btmikib-r 

So cntt. @«±(*Si3Zb4Hx^iaS(cJ:^r^* 
S/c*©WJWffl-C*So 

[0 06 8] Ml>rS 1 0 24STS 1 0 4CCji<&. Wi 

iBL/ca«±<**¥iag (xb, Yb) . mmm±.t*n2z 
b. mm±#&m Oxb, eyb, ezb) . >r 
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©§«£¥ (4S • (Xsup, Ysup, Zsu 

p, ©xsup, ©ysup, 6* zsup, Xswq, Yswq, Zswq, 0xsw 
g, flyswq, 6>zswq) A>6>. ^f5I^?SI»CC <fc -or^Btp 
©g«U&IWSiftg (£«) <tia»<Da«flaKEi5(4g (ffi 
til) 4*tf>. $ 6{c3tfc»©@«|RHI»{fc« (MS) 4 
@ti?J£¥{ig ©^ ( TAXsup, AYsu 

p, Azsupj 40 5) 4&*P©StMSHfli{&B (ffitt) 
4 (£&H8ifgtt() ©^ ( rAXswq, AYs 

wq, AZswqJ 4 05) 43<©'5o 
[ 0 0 6 9 ] t*t»T S 1 0 6tCjK». H#IS$!©5£II{t 10 
»-3nrH^©^(ca£or3a*IIBSM©ft0sup 4flW 

mmmne^ 43*&£. a>ts 1 osteite. «^ 

1 3 ©MiZ2©fif ©MErr 43?g>& <> AftB-JttW:. 0tt^© 

*p<. ai 2©*ia*»6S«c*jg»oraErr *»a 

[0 07 0 ] Hor S 1 1 OCCjt*. Err ©*ft*fl8#JK 

+»/h3t»*>53&»4WK-r*. s i i o n^ffikirt. 

HPfc. +fl-/hSt,»4£IWSft-54*ttS 1 1 2CcjB#. 
*©4*©±f*i«3Zb4B*±#*3Ccfc5£l,r:7n' 20 

[007 nw, S 1 1 0-C§tJnSifBS 1 1 
4 KM*. H^©«KS«cJ:o-c«i£S4JR«>a. ft. 

C©^«HErr ©554 Z br«»#0rf#fc *>©"?* 
So nor si 16 CCil*. 4©4#©@tiLt(*i§f3(C 

- S - Err 4^fcffi. BP£. MErr JO®® S43IDfc 
»4 Z b *6*W0fc«4frfc&±tt*3«t*ffi4 OX 
ZbtCRAU S 1 0 4t,cm&. 

[0 072]^, HROINIH^tt«qftt'>M«'r«S«± 
fttSSCC-S • Err 4flO&fcfl#SH8©;g8ia4iB*.& 30 
*§£#*5©r\ *©K«C«@«±»SF3i9l1i(B©S:S 
»4&*«>(c-r-5>©#iM£ CO. 

[0073]|25:7a-- ^-f— RCR&4, il«tS 

2 o «cja^a«Lh(t*Tfiai (xb.Yb ) . as±(*i« 
3zb. an±s&m (oxb, e>yb, ©zb) > pw©ati 

(JStHBSB) ftg-sgf* (Xsup, Ysup, Zsup, 6>xs 
up, 0 ysup, 0 zsup, Xswq, Yswq, Zswq, ©xswq, 6 ysw 

q, e zswq) frh$$a<Dm** ?f ^ ^xiftfSicj: -,r 
Sti&mSiSA. BP*. Wiffl0R<L), 12R(L) 
ttif 1 2ffl©M®©a*Hflt4*«i>5. **A:M«Sft« 40 
fulB L, R A M 7 4 (C tgfc*nr 5 . 
[0 0 7 4 3 ^1>T S 2 2 &Cil^. *»fcB«MSSft 4 

mmm^&umstn. (iu c©w©a-*-jj*iwffli 

r>xfW»ccj:->rB«lJE^tt« • g8&&4-#s 
f*iE3nr*>6ll8©ft#*&6ft-SA*. ChfcCOUi 
©gg4(iSJg©|I8jS4WL£cO©r\ vmiWK* 

[00 7 5 ] C©H*6©0Sg.W±gB©iP< fll«jRO/c© 50 
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r, iSiS^rai (ffi^iaj) ©±(*»5<*4l&< x^y-dr 
a"M.6*i*4*. ±l*©±T«*»J:OW®©«i**«» 
6*>r> *»ostti. jIK*JJ:0'ftDjIS©®*i*^S < ft 
S<fc9K:. aiE«:±<*J**4»3S^*Ci3&«-C#*. 

[0 07 6] ecc. jfrseLfcJ: -5 ccibtf* «c yT** 
A{c±{*g;<*4&s-r&c<fc#r£. -enfcs^orna 

tf4i$!i-rsc4#-ess. 
[007 7] H(c. 3$5W^tWlcc»or*ttfc5s;4& 
•jTl>5Ci*6, — *©«564SS*»%±lf*<b4©tt 

J#fe±lftt*4PJW«:»ffl3*iC4AJr*. &©JSf* 

mzi&ffiLxmrmcDmBnm&ii&ttm'b'hz < -rsc 
rts. 

[007 8] HOC, ±fltt)«K£fflfiidfctf:** < tt*«C 

^ftr««i»»©tttt*wccgffc (fSftn) u mrf6_h» 

©*&ifi#lSlt4«#yft*Ccfc o fc 4 s*4s|5g* iasci* 
6. j*?4<#-r#«>-5c4a*r*. CUhCCfcorfeSiiSCC 

±«cj*3 4tfe5e<c«.>u^a , r*{:4*j-c**. ft. ssie 
A$t«i (if*) utt<rfc. +#(c*#offi*rif 
an (if*) -rs*>©r*n«m». 

[0 07 9] <®8teC<D3m<D&2<DmB&<D&1&iC%Z 

siaB©flifiS4^-r«tt^o » f ar* o > 1a 9 «4©» 
[0 08 0] *2©mfc©0j»-c«. 08 t,ctjk?im< . 

o/co ^o^ftWictiai oK^vrj^c, (jaw 
a^p> ©@«fiia©«is)P4 > mn#? 

Ufc. 

[0 08 1] S9«^2©HJS©J^SI(C^Silg©S6 

M3.m 1 ©HJS©0ffi©0 5 4ISI«r *-5. 
[0 0 8 2] «TBHBT44. S 2 0 0 (C*jor(SS^ 

tc*-^t^r»ttj3n€»o nor s 2 o 2&cjt/^r@tiLL 

f*S3Z b?r(S^©L. S204^gTS206(CM 

r^ i ©Htt©0S«fci^«{cgfli±©(i«©a43*t«> 

[0 08 3] WT. S 2 0 8 ftO L 2 1 8 4Hlrgf 1 © 

-5. >*7S-$<D-^fim®M-e 4. »2 
©**t©J^Mt©«Kltt. #l©*jfc©JBJ8©4ti4a«c 
6&0„ 

[008 4] »2©**©?B»«±SB©ftl< «^Lfc© 

r. ffri©XMi©igfli4mi(c. ±l*igS4^</>*7^ 
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6*164 #. ±f*©±T«J*Scfct>*fiag5©ffibi* 

coo85]^. mi <Dmm<DBmt,az^z> t . m&ic 
fiK m.M%.¥JDmBMm*m , ETz>ct<,c&',x. mi 

[0 08 6 } ±*©±TI«l?:^^jif.tfcl,> 
©T#tttfIS#A# < TJ£¥2 2 R ( L) ©}gfl&K#ffi 

[0 087 ] @12 ttC©3^©#3 ©ISifcOJBMKCtt 20 

[0088] m3<Dnm<Dtems.m2(D$$M<DMm<D&. 

«l8*<fc9fg<lS:SLfc (> HPS. B12KM»t3HlBX 

*>6*«{>6tiA:3M£WiQ:a¥«u»'&^-r**. -educate 

0 fc»£fft^ ffiEBWtc-*? *. S J: 9 K 1/ fc. 30 
[0 0 8 9 ] 0 1 3tt**l(C«fc-?rifcje3ftS±tti«3 

fir* 9. ffi«D»**lR.«tt8l«cJ:*ffi*m-r. 0^©£n 

< . iiiws^ifisifoisa^rsiw 3 *tw 4 c t tc <£ 0 . 

±f*H3 4>{£< -T4 C 4#-CS S. 
[0 090 ] Hl%. 0^©2S^tf PjF? h 1 (Dmfffl 

W**ffi<-r*4. J8H8gpl6R (L) ^iift^fft 
Sc4(c<c»). ;^**fc«J# s. ffe 

»C*lil3W!«jl«f*i. «<&©±T«b#*#<«co 40 
rSSSJS^©±T/?!c^ (±TflDilS) ©^ttfJgits^if 
x., S8ffi4©&tfctt#SftL;rc9. Bffl»6©ffiltt7tf 

[0 0 9 1] JB3©3!it©J&fl8tt-fciB©fci< tifcSOfcC 
it, «MI«cj£i;"C±»i»S*(S<r*ci*i-c*. ± 

[ 0 0 9 23014 «C©^©^4©HJS©0Sg{C^ 
*iHB©««iS*7ivr««^a v i-ItifeS. 

[ 0 0 9 3 ] * 4 © XMKDJgft . * 3 ©XilOJNII £ 
I5M$CC. Sf2©3Ht©JI5*©SOi5W"C*»). 0^©£n 50 
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< , 3a©£¥«U»'*?>--*«-5*.&J:9«:(sft:. BP 
% - (RfflS 3 FfUB' < 9 > - * 1 . *3fe©S < ^ ^ 

[0 0 9 4] (RfflajpttBHWHT A=f 'J X A 2 -CUtffl 3 

tflsB • *») «. * i ©ies6©«»-cas-s/t**fl<«c« 

x'A 3 -C»tH3n^(Sffl<B{ie!|lfflct 9 fcjBfttcSWrr 

[0 0 9 5 ] |3jliic, ±j*!S3^ST;l'=f yXA63fl 
ll^n, ±#JBSTiU=fyXA2-CSHEStiS*l© 

;U=fyXAl, 3"C^jesti*fil2bl,3 a. ±f$iii3© 

coo96] jftss n/c 3 f oeitx^tf ^^a ^ 5> 
*jt>€>nfc±ftiS3*j<fco*-e©ffe©>'^-7y- *ccs^c> 

[0 09 7] m4<D9m<D&mte±S&<DtQ< mf&LtcCD 

v. se«r©sa(i©jg«4ra«©ja«**-rs4ft{c > a 

^©An < . 3 <l©jgff5©¥^l(azbav^ #i6 5Ci T'JIig 

»3?r/J>3 < tSCimS. CftiCJ:oT|Sg&£# 
n -T 4 4 * Aj: £■ ^©Sf$© A-i* t»*tf *tf 5 BRK t . ± 

[0 09 8] CCt, *2ttl>L.»4<C««©^«rffl 

b ) »S¥©«l^€. *tBHIA3Wfe{C«SftLfc7^;U 
$ (^S^F5-3 2 4 1 1 5#IB«g©fi?SR) *«t,»r*fe 
SWS*B^«:». *©«*5£8te-r6-4-. 

c ) aawjEYosaMMtKc. BfsE©-r6L«©^nM» 

[0 09 9] »2&t,»um4©jUfi©^Sg{C*Jl» 

Uli^iT^gU. ±f*©@«*¥{ig£-r<E»-fiS^ 
©PH^WTKiTn-r. 

a ) @S±f**¥«l^5, ^«):r-2 7--x>i/-etets:3 

*>. ^a^i t j: o fe*sNFra5fe©ses±(*[4g=&$i* 

[0100] 
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c»i i 

m 

Xbv(t)=2WnXb(t + kAt> 
k=n 

fcrtfU 

Xb(t) Itmmoz IS±(**¥ti 

xbv(t) ttv$me>mm±.tt*.*¥-tfcm, 

[o i o i] b ) m&<Dsm±ft*¥-im*y -ovzic 
ii-r. w*tf. 7-^*©£i§rai$!£ 

(TnS +1)/ (TdS +1 ) 

tdSJ:«S;©«i^J; 0 fel«HIW«:^tf-r 4. 
[0102101 5 «£©&!§©& 5 ©HSS©JgagK:<& 

aiig©if j&fc^-rsti^a v ^0-e* o . h i e «* 

[0103] *5©**©JBttT?B:. 19 1 5 tc^-Titp 

*to/t±f*WS5r7 -< (a-/\-*7 ^ ;l<50 tc*»W 
r¥»ib«ffl%ff 5 «fc "5 K U1t. 
[0104] «t. *5©£3t©0««:fliS±f*i*3ifc 

1 ©3BW©JB«©05 iBMar**. 

[0 1 0 5 ] WTSiWr-Si, S3 0 0tC*Jl»t*lO 

■ ? + - h) Zmr U. ±ftiS3Zb^i*5. ft, ± 
(cct rjRjftjKj iOT&^&citf-c 

[0106] iH>TS 3 0 2CCji^-*i6/c±^iaS3(C 

[0107] »5©i?*©jg«tt±ia©*p< flteso/tc 
it. ce«r©iijs©».«©3ai*«:*n*r^itffcteatcj: 

s. 

©ft ©IB) *iff«Er«BltttSW*«<*i. «*.«. Ft© 

as. 

[0 1 0 9 ] 0 1 7ttC©ftH©flt6©3llt©iBflMCff 
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[Olio] ®6©nss©^cc*or«. ©HSS 
©#ffltem»r»fcB«±fttSS (0 1 IMif^ ) 

[0111101870-- ? + -h**JHO-C»6© 

io 3as©»Mwc»*«Ea!©±»j*3«3£r^=f >;xa*w 

[0112] jfe-f S 400 fcJBHTJU 1 ©3U6©J$»T? 

0 6 tew o •cm^tcmw&tfi xm^mv<omm±» 
mz cm i m&B) «c>r s 4 o 2 tciix,-^ 

[ 0 1 1 3 1 m*x s 4 0 4t,cmA,rmi±mm (mm 

20 t) TOIWI, W24aft5. fit,, 1*W1, 
W2«, Wl +W2 = 1 Wl, W2^-Wn 

©■*IHKfb#»6frr**j;5K:jfc5£ , rs. M<,>TS 4 

0 QicmAsVtjQmw-miznmTz. bp%. *i. 02 
ommmtzikm u tcm&w 1 , w 2 4* o r f# tern* 

[01 141 »6©iai©»»{c*or«±E©*n<* 

^f-sci-c. sew©st»©jg!»T©ja*(cttiii.r. a 
«±(*WS«CO(,»r. miMjgfl5K3stL-cm«m2© 
ammzfrz— Mrnti 0 k-ts 4 , ±tis»i ) &w 1 

30 {SMT&Ct&VZ&o {&U h 0 £SS< 

h©^ (^mmnom.) *jffaoa<tt*«ti*j* 
[oii5]^, m6<Dmm<DBmx'< l tw.mm^2'o(D 

mZmLtctf. 3(l«±(c^ffi?SpJte-c«.4 0 Etc. fln 

[01 16] *6©syfc©B«r«. m2jwM 

cm 5 ©H*fi©^K^Lfc^feW©*ffi*ffl^r{f 

40 cfc -5 L/ . m 1 <DWfc<Dfcmt£ 5 © JlJfe© 

ioii7imif. 0 1 vmmmm. »2©ntt© 

ff^. *4C>«fB3«:t>L»5©**6©^««:ffl«r>ril> 
^c< ±t> 1 <l©±(*iS3M»^*s!>. KCfOW?: 

^*fca^©±f*iii s mmmzsLtftL r ^-ne.©/i^ 

[0H81BK, «T©*tttc«fcor«ift^*»rfe 
50 4) 
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b ) £**tt£©B*IHH« (tt«WtCOWSO««'C 
j£-<fc) 

c ) 7 a * $ u £<d&x.wxk. £~,-c'mhti2>&B 
e ) *v u>-cm i omnmmzm^t i ##©m 

7*;U*KM0T*2-f'--:7JW©tft5j&»6 (tftSMN) tS 
[0 1 19] »5©!Bfc©JIS»£Sfc»). *ffie«»a 

C 0 1 2 0 ] H 1 9 BCOIBBO»7 ©XMKNBtttCflt 20 

s«a©#ss*^r«iB^O!y*iar*»). i2 0(« 
©sfrfp&^-r^p- ■ ft-hr-^„ 
[0121] ^7©J|Ji©^SS«:*or«. 316 ©USS 
©^«J+ Si 5 ©|Qt©».«*ffl t, > rf#/c a«±f*iS 3 £ 

[0122I1207P-' + - h**sfl80r»7© 

n*©jB»{c«4±ttiS3»iST;i/=fyxA*ttwr 
s„ ^s^ccisa-r-5^-f>T;u=fyxA«»i© 

£S*©JB»©IS 5 <b R«-C * & . 30 
[0 1 2 3 ] teTFIHWrSi. S 5 0 5 0 6 

k*j i > -ess 6 <owfc<r>w& t mmcmm*n r stn± 
fcf&. s 5 o 8 ft^rff/cffitcigs ©iits 

[0124] »7©!6Jt©JB»tt±IB©iP< *fiKL//c© 

[ 0 1 2 5 ] 02 1 «C©^©08©*M©7f^(C{£ 
sa5«©«(R*^-r«M6^o v ^H-C&So 40 
[0126] si8©|git©*»K:*o-c«. B^©in 

< . » 7 ©3g*6©^fflUD«JiS*afe5lJi* «fc "5 CC L fco 

*W1, W3. W5. £>&(,>«W2. W4, W6«. ^g- 
[0127] IB8©j£i6©JgSgK*J^Ttt±iE©an< & 50 
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sSLfccir. ^iUrwS!HU©lliS©ffJSS«:l:k$5L 

[0 128]^. Ctl«±{C3p»ft**l.»«»I«^* 

f**9JW«p-rsc4**-c*ac». ±f*©±Tttijia«(s 
iSLT4>. «g5©as. ffinsw:. Mccitfln-r sfftsj# 

[ 0 1 2 9 ] B2 2 »C©%m©99©|ft%©JftBK:ffi 
S*«©*fiR*^-r»WH-C*4. ft9©£ft©JgStC 
fet>TB4S (JS) ^ffOOiK? h**t*<!:U ^©*fc 
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